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Abstract 
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manipulator  with  idler  wheels.  This  assembly  is  actuated  by  shape  changes  of  its  mod¬ 
ules,  which,  under  the  influence  of  the  nonholonomic  constraints  on  the  wheels,  induce 
a  global  motion  of  the  assembly. 

We  formulate  the  kinematics  for  a  generic  assembly  of  this  type  and  specialize  to 
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1  Introduction 

In  this  paper  we  consider  a  class  of  Variable  Geometry  Truss  (VGT)  assemblies 
(Miura,  Furuya  &  Suzuki  [1985];  Wada  [1990]),  which  are  structures  consisting  of  longi¬ 
tudinal  repetition  of  truss  modules.  In  the  present  instance,  each  module  is  implemented 
as  a  planar  parallel  manipulator  consisting  of  two  platforms  connected  by  legs  whose 
lengths  can  vary  under  the  control  of  linear  actuators.  Each  platform  is  equipped  with 
a  pair  of  wheels,  so  that  it  can  move  on  the  plane  that  supports  the  structure  (fig.  1.1). 
The  wheels  of  each  platform  are  free  and  not  actuated  and  their  motion  is  independent 
of  each  other,  while  we  assume  that  the  wheels  roll  without  slipping  on  the  plane.  This 
imposes  a  nonholonomic  constraint  on  the  motion  of  each  platform,  namely  the  require¬ 
ment  that  its  velocity  is  perpendicular  to  the  axis  connecting  the  wheels.  When  the 
legs  of  the  individual  modules  are  expanded  or  contracted,  the  shape  of  the  whole  VGT 
assembly  changes.  As  a  consequence  of  the  nonholonomic  constraints  imposed  by  the 
rolling-without-slipping  assumption  on  the  wheels,  this  shape  change  induces  a  global 
motion  of  the  VGT  assembly. 


Fig.  1.1 


The  motion  planning  problem  for  such  an  assembly  is  of  the  nonholonomic  vari¬ 
ety.  There  is  a  significant  body  of  research  related  to  such  problems  (see  e.g.  (Latombe 
[1991];  Li  &  Canny  [1993])),  which  in  general  assumes  cart-type  mobile  robots  mov¬ 
ing  under  direct  actuation  of  a  set  of  wheels.  The  main  difference  in  our  case  is  the 
prominence  of  shape  changes  as  the  means  which,  together  with  the  action  of  the  non¬ 
holonomic  constraints,  induces  global  motion  of  the  system.  This  is  analogous  to  the 
idea  of  reorientation  in  free-floating  multibody  systems,  induced  by  closed  joint  space 
trajectories  under  the  nonholonomic  constraint  of  conservation  of  angular  momentum 
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(Krishnaprasad  [1990];  Krishnaprasad  k  Yang  [1991];  Marsden,  Montgomery  k  Ratiu 
[1990]). 

VGT  assemblies  of  the  type  discussed  here  have  been  examined  in  the  past  (see 
(Chirikjian  k  Burdick  [1991];  Wada  [1990])  and  references  there),  but  the  emphasis 
was  on  its  capabilities  as  a  redundant  manipulator  and  on  locomotion  using  snake¬ 
like  motions,  not  on  the  special  problems  introduced  by  nonholonomic  constraints.  A 
system  similar  to  the  one  described  here  was  built  by  (Chirikjian  &  Burdick  [1993])  using 
castors  instead  of  wheels  in  the  platforms  of  the  modules  and  therefore  the  nonholonomic 
constraints  that  we  consider  here  were  not  present.  A  visit  to  Burdick’s  lab  in  Caltech 
in  1992  was  a  source  of  inspiration  for  the  present  work. 

In  section  2,  we  examine  the  kinematics  of  a  VGT  assembly  with  t  modules.  Con¬ 
sider  the  i-th  module  (fig.  1.1).  Its  shape  can  be  described  by  the  relative  position 
and  orientation  of  the  coordinate  frame  centered  at  the  point  0;+i  with  respect  to  the 
coordinate  frame  centered  at  the  point  0{.  Then,  the  shape  of  each  module  corresponds 
to  an  element  of  the  Special  Euclidean  group  SE( 2)  that  describes  rigid  motions  on  the 
plane  and,  as  a  result,  the  shape  of  the  ^-module  VGT  can  be  described  by  t  elements  of 
SE( 2).  The  configuration  of  the  VGT  assembly  can  be  described  by  its  shape  and  by  the 
position  and  orientation  of  the  assembly  with  respect  to  some  fixed  (world)  coordinate 
system,  thus  by  a  total  of  t  +  1  elements  of  SE( 2).  In  (Brockett,  Stokes  &  Park  [1993]) 
a  systematic  way  of  deriving  the  kinematics  of  serial  linkages  is  presented  based  on  the 
“product  of  exponentials”  formula,  where  the  configuration  of  the  system  is  described 
by  an  element  of  the  appropriate  SE(n)  group  and  is  expressed  as  a  product  of  its 
one-parameter  subgroups,  with  one  element  of  the  product  corresponding  to  each  of  the 
one-degree-of-freedom  joints  of  the  linkage.  The  VGT  assembly  that  we  consider  here 
is  a  structure  similar  to  the  ones  described  there,  but  the  joints  are  more  complicated 
parallel  manipulator  modules  with  more  than  one  degree-of-freedom  each.  Moreover, 
the  whole  assembly  is  not  anchored  to  a  base,  but  is  free  to  move  on  a  plane  and,  finally, 
nonholonomic  constraints  are  present,  in  addition  to  the  holonomic  ones.  However,  an 
extension  of  the  above  method,  allows  us  to  systematically  derive  the  kinematics  of  the 
VGT  assembly  as  follows:  Using  the  Wei-Norman  representation  of  SE( 2),  we  express, 
in  section  2.1,  the  shape  of  each  module  as  a  product  of  the  one-parameter  subgroups  of 
SE( 2).  Then,  the  configuration  of  the  whole  assembly  can  be  expressed  as  a  product  of 
such  one-parameter  subgroups.  Using  the  notion  of  the  adjoint  action  of  SE( 2)  on  its 
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Lie  algebra,  we  determine,  in  section  2.2,  how  the  motion  of  a  module  relates  to  the  mo¬ 
tion  of  the  other  modules  of  the  assembly.  We  also  express  the  nonholonomic  constraints 
in  a  compact  form  that  can  be  used  to  make  explicit  the  dependence  of  the  assembly 
configuration  on  the  shape  of  its  modules.  This  allows  us  to  characterize  the  dependence 
of  the  global  motion  of  the  assembly  on  the  shape  controls,  namely  the  changes  in  the 
shape  of  each  module,  which  are  expressed  as  elements  of  the  Lie  algebra  of  SE( 2).  In 
section  2.3,  we  consider  the  implementation  of  each  module  as  a  planar  parallel  manipu¬ 
lator.  The  shape  of  each  module  is  determined  by  the  lengths  of  the  legs  of  the  parallel 
manipulator.  From  the  velocity  kinematics  of  the  parallel  manipulator  we  conclude  that 
motion  planning  schemes  for  the  VGT  assembly  can  disregard  the  particular  details  of 
the  implementation  of  the  modules  and  only  consider  the  shape  of  each  module.  Thus, 
instead  of  considering  the  changes  in  leg  lengths  as  controls  for  the  VGT  assembly,  we 
can  use  the  corresponding  shape  controls  of  each  module. 

In  section  3,  we  specialize  the  previous  discussion  to  the  2-module  VGT.  Unlike  the 
generic  ^-module  case,  here  we  have  exactly  the  number  of  nonholonomic  constraints 
that  we  need  in  order  to  determine  the  position  and  orientation  of  the  VGT  assembly 
with  respect  to  the  world  coordinate  frame,  based  on  a  sequence  of  shape  changes  from 
a  reference  shape.  As  a  result,  we  can  demonstrate  how  shape  changes  of  the  VGT 
assembly  induce  a  global  snake-like  motion  due  to  the  nonholonomic  constraints.  We 
consider  the  motion  planning  problem  under  a  specific  shape  actuation  scheme,  where 
one  of  the  two  modules  is  responsible  for  the  motion  of  the  assembly  through  periodic 
changes  of  its  shape  and  the  other  module  is  responsible  for  steering.  We  demonstrate 
how  to  generate  primitive  “straight  line  motion”  and  “turning”  behaviors  and  we  show 
by  computer  simulations  how  to  synthesize  these  into  more  complex  ones,  like  avoidance 
of  obstacles. 

In  section  4,  we  discuss  possible  extensions  of  this  work. 

2  Kinematic  Chains  on  Lie  Groups 

In  section  2.1  we  discuss  the  Wei-Norman  representation  of  curves  in  SE( 2)  and 
in  section  2.2  we  apply  this  representation  to  the  derivation  of  the  kinematics  of  the 
^-module  VGT.  It  is  found  convenient  to  employ  the  language  of  matrix  Lie  groups 
throughout.  In  section  2.3  we  consider  the  implementation  of  a  module  of  the  VGT 
assembly  as  a  planar  parallel  manipulator. 
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2.1  The  Wei-Norman  Representation  of  SE(2) 

The  instantaneous  shape  of  a  module  of  the  VGT  assembly  or  the  position  and  ori¬ 
entation  of  the  whole  assembly  with  respect  to  the  world  coordinate  system  corresponds, 
as  was  discussed  in  section  1,  to  an  element  x  of  the  matrix  Lie  group  G  =  SE( 2).  Given 
a  curve  x(0  C  G  =  SE( 2),  there  is  a  curve  y(.)  C  Q  —  se( 2),  the  Lie  algebra  of  SE{ 2), 
such  that: 

X  =  X^.  (1) 

Let  {Ai,  i  =  1,2,3}  be  the  following  basis  of  Q  : 


{A\,A2,As} 


/0  -1  0\  /O  0  1\ 

1  0  0,0  0  0 

\0  0  0/  \0  0  0  / 


/0  0 
0  0 
\0  0 


(2) 


with  [ ,  ]  being  the  usual  Lie  bracket  on  G.  Then: 

Mi  ,  -A]  =  -43  ,  Mi  ,  A3]  =  —-42  ,  M2  ,  A3]  =  0  . 


(3) 


Let  Q *  be  the  dual  space  of  Q,  i.e.  the  space  of  linear  functions  from  Q  to  JR.  Let 
{^,  i  =  l,2, 3}  be  a  basis  of  Q*  such  that  ^t-(Aj)  =  6j,  for  i,j  =  1, 2, 3,  where  S{  is  the 
Kronecker  symbol.  Then  the  curve  V(.)  C  Q  can  be  represented  as: 


i=l  i=l 

Here  u,-  is  a  scalar  function  of  t,  the  curve  parametrization. 

For  x,y  £  Q,  define  (adx)y  d=  [x,y],  ( adx)ky  =  [x,(adx)k~1y\.  Then,  from  the  Baker- 
Campbell-Hausdorff  formula  (Wei  &  Norman  [1964])  we  have: 

exye~x  =  (eadx)y  =  y +  [x,y]+ ^[x,[x,y}]+ . . .  .  (5) 


Proposition  2.1.1 

Let  x(0)  =  /,  the  identity  of  G.  There  exists  a  global  representation  of  the  curve 
x(-)  C  G  of  the  form: 

=  6'riOMie'i,2(*M2e'Y3(<M3  _  (6) 
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The  coefficients  7j  € 


]R  are  related  to  the  coefficients  v{  in  (4)  by: 


/  1  0  0\/«i\ 

I  73  1  0  )  I  v2  j 

\  72  0  1/  \V3/ 


CO 


and,  equivalently,  by: 

t 

7i (*)  =  7i(0)  +  J  vi(T)dT  » 

o 

72(t)  =  72(0)<7(<,0)  +  73(0)5(t,0)+  l  v2(T)C(t,T)dr  +  J  v3(r)S(t,  r)dr  ,  (8) 

o  o 

i  ‘ 

73(f)  =  -72(0)5(t,0)  +  73(0)C(i,0)-  I  v2(r)S(t,T)dr  +  I  vs(r)C(t,  r)dr  , 

o  o 

where  C(t,r)  di'  coS  (/ ..(^t)  «(‘.r)  =  *  (  J  "iM^)-  F”  ««  WtiaI 

dition  x(0)  =  I,  we  have  7i(0)  =  0,  i  =  1,2,3. 

Proof 

Since  £7  =  se(2)  is  solvable,  the  existence  of  a  global  representation  of  the  form  (6) 
is  immediate  by  (Wei  &  Norman  [1964]).  Differentiating  (6)  we  have: 

e72^2 A2e*M  +  73c''^1e72^e73-4M3i 

dt 

_  em^ie7^2e73^[7ie-73^e-7^Mie73^e73^  +  j2e~l3A3A2el3A3  +  73^3]  ^ 

_  ^  j7ie«rf(-73^3)eo<i(-72^2)>41  -)-72eati(-'73^3)^42  +73-^3] 

We  now  compute  the  RHS  of  (9).  From  (3)  and  (5)  : 


ead(-73>l3)_42  _  f 

ea<i(-73^3)ea<i(-72e42)^i  _  ^(-73^3)^  _|_  ^^3)  =  ^  -  73^2  +  72-43  • 


(10) 


From  (1),  (4),  (9)  and  (10)  we  have: 


V  =  ui>ti  +  v2A2  +  V3A3 

=  71  (-4X  -  73^2  +  72*43)  +  72*42  +  73-43  =  7i-4i  +  (72  -  737i)-42  +  (73  +  727i)-43  • 
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Since  {yti,^!^}  is  a  basis,  we  have: 

»i  =  7i  ,  «2  =  72  -  737i  ,  vz  =  73  +  7271  . 
Solving  for  the  7,-’s  we  get  (7),  which  can  be  rewritten  as: 


7i  =  vi  , 

(£)-U  o  )(;;)+(:;)• 

This  system  can  be  solved  by  quadratures,  giving  (8). 


For  x  €  G,  V  6  G,  define  the  adjoint  action  of  G  on  Q  denoted  Adx  :  Q  Q  by: 


AdxV  d^f  x^x"1  • 


(11) 


From  (4)  we  have: 


AdxV  =  Y^ViAd^i  =  j^(Vr)Adx.Aj 


(12) 


t=l  i=l 


Proposition  2.1.2 

Consider  the  Wei-Norman  representation  (6)  of  x  determined  by  (7)  and  (8).  Then: 

Adx-\A\  =  A\  —  J3A2  +  72^3  ? 

Adx-iA2  =  cos  71^2  -  sin  71^3  ,  (13) 

Adx-iAz  =  sin  71^2  +  cos  71 .43  . 

Proof 

From  (11)  we  have  for  i  =  1,2,3: 

Adx-iAi  =  . 

From  this  and  (5)  we  have  for  A\: 
e*K-TiAi)Al  _  Al 

ea di-.j2A3)ead(-T1A1)Ai  _  ^(-7^)^  =  ^  +  73^3 

ead(-73>l3)ead(-72^)ea<i(-yM1)^i  _  ^(-73^3)^  +  =  ^  _  73^3  +  72^3  • 
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For  A2  '■ 


ead(  =  cos  71^2  _  sin  71  A3 

ead{—y2M)  e^(-~n^A  =  ea^-72'42^(cos7i»42  —  sin  71  A3)  =  cos  71A2  —  sin  71A3 

ead( — nAs)  ead(-72Ai)  ead( — =  ead^~'1z'^3\cOS^\A2  —  sin7iA3) 

=  cos  71 A2  —  sin  71  A3  • 


For  A3  : 

ead(-rnA1)^3  _  sjn  7j^42  4-  cos  71.43 

ead(  — y2^2)ead(-7i^3)^43  _  ead(~l2A:i\sm^1A2  +  cos  71  A3)  =  sin  7i-42  +  cos 71  A3 

gad( — y3A3)ead( — nA2)  ead{ — yi^i)^  —  ead(  ^-^(sin  71^2  +  COS  71^3) 

=  sin  71^2  +  cos  71  A3  • 

I 


Using  the  definition  of  the  basis  {A},  we  have  from  (6)  : 


x(0  = e 


cos  71  —  sin  71  72  cos  71  —  73  sin  71 

_  piiAx  ei2A2  e~tzA3  _  j  sin7l  cos  71  72  sin  71  +  73  cos  71 

0  0  1 


(14) 


Define: 

def 

x  =  72  cos  71  -  73  sin  71  , 

def  .  , 

y  =  72  Sin  71  +  73  cos  71  , 

,  def 

<t>  =  71  • 

Differentiating  and  using  (7)  we  have: 

x  —  cos  71  -  u3  sin  71  , 
y  =  u2  sin  71  +  u3  cos  71  , 
4>  =  vi  . 


(15) 


(16) 
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2.2  The  ^-module  Variable  Geometry  Truss  (VGT) 

We  consider  a  chain  of  l  modules  of  the  type  shown  in  fig.  1.1  and  2.1.  Each  module 

consists  of  a  planar  parallel  manipulator  with  one  pair  of  wheels  per  platform  and  with 

each  wheel  rotating  independently  from  the  other  around  its  axis,  both  forward  and 

backwards.  Neither  wheel  pair  is  actuated  and  we  assume  that  the  wheels  roll  without 

slipping.  This  system  has  n  =  3(^  +  1)  degrees-of-freedom,  its  configuration  space  is 

Q  —  SE(2)  x  •  •  •  x  SE( 2)  and  it  is  subject  to  3^  holonomic  constraints  from  the  parallel 

' - - - ' 

/•fl  times 

manipulator  legs  and  to  p  —  £  +  1  nonholonomic  constraints  from  the  rolling-without- 

slipping  wheel  motion.  The  configuration  of  the  assembly  can  be  determined  by  its  shape 

(which  is  an  element  of  the  shape  space  S  =  SE( 2)  X  •  •  •  X  SE( 2)  )  and  by  the  position 

' - - - ' 

l  times 

and  orientation  of  the  assembly  with  respect  to  the  world  coordinate  system  (which  is 
an  element  of  G  =  SE(2)  )  .  Then  Q  =  G  x  5. 


Consider  a  world  coordinate  system  centered  at  0 o  and  platform  coordinate  systems 
centered  at  0,-,  i  =  1,  ...,£+  1.  Let  x.  £  G  =  SE(2)  be  the  configuration  matrix  of  the 
i-th  platform  with  respect  to  the  world  coordinate  system.  Define  V,-  G  Q  —  se(2)  by: 


From  (4)  we  have: 


u  =  E«Mi 


Also  define  v'  —  (  v[  v\  )T  =  (  Aj(Vi)  A$(Vi)  )T. 


(17) 


(18) 
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Let  x .  .  €  G  be  the  configuration  matrix  of  the  (t  +  l)-th  platform  with  respect  to  the 

coordinate  system  of  the  j-th  platform.  Define  Vjj+ \  G  Q  by: 

X . ...  =  X .  ...  Vjf>i+1  ,  for  i  =  1, . . . ,  /  and  1  <  j  <  i  +  1  .  (19) 

Jl*  T  A  J  t  •  l  1 


From  (4)  we  have: 


VjMi  =  =  EfcMi  • 


k=l 


k=l 


(20) 


Also  define  =  (  v('i+l  v{'i+l  u|-,+1  )T  =  (  A\(Vjti+1)  4(Vili+ 1)  ^(Vjli+l)  )T-  Ob¬ 

serve  that  the  x .  ,+1’s  and  the  Vj^+j’s  are  the  shape  variables  of  the  chain. 

The  shape  of  the  VGT  assembly  is  determined  by  {x.  .  ,  i  —  1, . . .,£}.  The  veloc- 

l  jt"f*  1 


ities  {Vj),+1,  i  =  1, . .  .,£}  are  called  shape  controls  for  reasons  to  become  obvious  at  the 
end  of  this  section. 

By  (6),  (15)  and  (16)  we  have: 


X  (t)  =  c'ri(<Mic72(*M2e'r3(<M3 


—  sin  (fri 

COS  (j>i 


0 


(21) 


and 


(22) 


where  the  7’s  and  the  corresponding  v’s  are  related  by  (7)  and  (8).  By  the  system 
kinematics  we  have: 


*,'+i 


=  x.x. ...  =  x,x. , 

t  1,1+1  1  1,2 


i  = 


(23) 


and 


>  fcri*  1 . 1  “4  1  S  J  <  i  +  1  •  (24) 


Define  x .  .  =  I,  where  I  is  the  identity  in  G. 
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Equations  (23)  with  (21),  (22)  can  be  seen  as  a  generalization  of  the  “product-of- 
exponentials”  formula  of  (Brockett,  Stokes  &  Park  [1993])  for  kinematics  chains  with 
more  than  one  degree-of-freedom  per  joint. 

Proposition  2.2.1 

The  velocities  of  the  (i  +  l)-th  module  depend  on  the  velocities  of  the  previous 
modules  as  follows: 

Vi+ 1  =  Adx- 1  Vi  +  Fiii+1 
«,»+i 

=  Ady-  1  •  •  •  Ady-  1  Vj  -J-  Ady-1  •  •  •  Ady-1  V\  2 

i,»'+l  1,2  i,i+l  2,3  ’ 

+ - 1-  Adx- 1  Vi-i,, •  +  , 

i,«+l 

(25) 

Vj,i+i  —  Adx-i  Vjti  +  V,i+i 

«,»+l 

—  Adx- 1  ••■Adx- 1  Vj'j+i -\- Adx-i  ■  •  ■  Adx- 1  ^j+i,j+2 

»,»+!  i+l,j+2  »,«+l  j+2,i+3 

+ - (-  Adx-i  Vj_i ,,  +  Vi,i+i  • 

*,t'+i 


Proof 

From  (17)  and  (23)  : 


X.,1  =  x.x.  ...  +X.X.  ...  =  X.ViX.  ...  +  X.X. 

1+1  1  1,1+1  1  *,1+1  1  1,1+1  1  1,1+1 

=  x.x.  ... [x_1  Vi X.  +  vi)i+1] 

*  *,*+1  ,,,+1  »,»+! 


—  X.,AAdx-i  Vi  +  V+i+i]  , 

*  +  ■1  4*  1 


1,1+1 


(26) 


x...  =  x.x.  •••x. ...  +X.X.  •••x. ...  +  •••  +  x.x.  •■•x. ... 

i+l  1  1,*  1,1+1  1  1,2  1,1+1  1  1,2  i,i+l 

=  xi+i!'4,i*'j+1  ■  +  A\\+1  ■  ■  ■  (27) 

+  •  •  •  +  Adx- 1  Vj_it;  +  Vi, ,-+i]  • 
i,i+l 

Then  (25)  follows  from  (17),  (26)  and  (27).  The  equation  for  V,-,i+i  is  derived  similarly. 
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Corollary  2.2.2 

Equations  (25)  induce  the  following  relationships  between  the  positions  and  veloci¬ 
ties  of  the  (i  +  l)-th  module  and  those  of  the  previous  modules: 

uj+1  =  u*  +  v;-i+1 , 


Moreover: 


t>2+1  =  -uj73,,+1  +  v\  cos7j’,+1  +  v'a  sin7j’,+1  +  i>2,,+1 


,,,+1  =  ui7‘-*+1  -  V2  sin7{,l+1  +  V3  cos7j’,+1  +  v- 


*',«+ 1 


*i*+i 


(,v+1 

y3 


<+1  =  <i  +  t,j’i+1, 

vi'i+1  =  -uf*73,i+1  +  4'*  cos  7‘li+1  +  v"  sin  7{>,+1  +  v‘*<+1 

7.1+I  j.i  t.i+1  j.i  *  i.t+1  ,  i.i+1  ,  t.i+1 

v3  =  «i  72  ~v2  sm7i  +  t#cos7x’  +  v3’ 


Ti+1=7i+ir+1, 


7i+1  =  72  cost!"*  +  --3  sinTj'”1  +  7; 


t,f+l 


*.»+!  ,  <,»+! 


73+1  =  -72  sin  7i’1+1  +  7s  cos  7i’,+1  +  7a 
7  {'<+1  =  7i’*  +  7l’i+1  , 

72,1+1  =  72 cos  7^t+1  +  73’'  sin  7{’,+1  +  72>I+1  , 


*.«+!  ,  ^,*,*  +  1 


(28) 


(29) 


(30) 


(31) 


73"  '  ‘  =  -72J,‘  sin  7i’t+  +  7a  cos7;’,+1  +  7^ 

Proof 

From  (4),  (25),  (12)  and  (13),  observing  that  {.4;}  form  a  basis,  we  get  equations 
(28)  and  (29).  From  (14)  and  (23)  we  get  equations  (30)  and  (31). 


The  nonholonomic  constraint  of  rolling-without-slipping  on  the  wheels  of  each  plat¬ 
form  can  be  expressed  using  (16)  as: 

v'2  -  A^Vi)  =  i0i  cos  cpi  +  y0i  sm<f>i  =  0  ,  i  =  l,...,f+l.  (32) 

Define  the  composite  velocity  vector  of  the  VGT  assembly: 

def  t  1 1  1,2  1  1  l,l+\  \T 

V  =  (  17  I  V  ’  I  •  '  •  I  V  ) 

=  (^Kw---Kwli4'e+1^+1)T 

=  (4(^i)4(^)4(Vi)!4(Vi,2)--  -  Mi(Fv+i)4(Vr.r+i)^(Vr,r+i))T  . 
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Proposition  2.2.3 

The  p  =  l  +  1  nonholonomic  constraints  (32)  can  be  written  in  matrix  form  as: 

A(X1,2’ •••’*/,/+  l)V  =  0’  (33) 

where  A  is  a  function  of  only  the  shape  of  the  VGT  assembly  {x.  ,+1> 1  =  1>  •  •  • ,  and 
is  a  block  lower  triangular  matrix  of  maximal  rank  of  the  form: 


(  14 

0 

0 

*1,2 

*2,2 

0 

A(x  ,  • 

•  -,X, ,  J  = 

• 

• 

'1,2 

e,i+  iy 

*i,i+i 

*2,t+l 

*2,M-1 

0 

0 

0 

0  \ 

0 

0 

0 

0 

0 

0 

0 

*»,»+ 1 

*»+l,i+l 

0 

0 

I 

■  . 

0 

*t,r+l 

*«+M+i 

•  •  •  *r,m 

(34) 


with  the  fc-th  block  of  the  ( i  +  l)-th  line  defined  as: 


=  (  A2(Adx-i  Ar)  Aj(Adx-i  A2)  A\(Adx-i  A3)  ) 

V  fc,t+l  fc,i+l  k,i+ 1  / 

=  (  A2(Adx-i  •  •  •  Adx~  1  Ai)  A2(Adx-i  •  •  •  Adx- 1  A2) 

\  »,i+l  k,k+ 1  »,t+l  k,k+ 1 

A\{Adx-i  •  •  ■  Adx-i  A3)  ) 

i,»'+l  k,k+l  J 

=  (  -  73fc,’+1  cos7j’,+1  sin7i’,+1 )  >  for  k  <  i  +  1  , 

*k,k  —  (  A2(Adx-i  Ai)  A2(Adx-i  A2)  A2(Adx-i  A3)  J 

V  k,k  k,k  k,k  / 


=  (010), 

*k,i+ 1  =  (0  0  0), 


for  k  =  i  +  1  , 
for  k  >  i  +  1  . 


Proof 

From  (25),  (18)  and  (20),  we  get  for  i  =  1, . . . ,i  : 

0  —  A^Vi+i)  =  Ab(Adx-i  ■•■Adx-iV1)  +  A\(Adx-i  -  •  •  Adx-i  V1>2) 

i,i+l  1,2  «,«+i  2,3 

+ - hA2(Adx-i  Vj—i^)  +  Aj^Vi.i+i) 

»,«'+! 
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=  A  (Me-  ■  •  •  Adxr\(E  Aw HO) 


*,*-4-1 


+  A\(Adx->  ■■■Adx-i  (E^O'wMi)) 


*,t+l 


2-3  7=i 


+  ...  +  A\{Adx-r  (J^VU.O^))  +A(ViM1) 


.•,.+1  j=1 


■■■Aix-iAi)A)(Vi) 


3  =  1 


*',*-4-1  1,2 
3 


+  J2  4(^X7!+1  •  •  •  AdX~l3A3)A)(Vl,l) 


+ - 1*  E  ^(^X-1  Aj)A)(Yi-l,i)  +  AtAi.i+l) 

*■  *  -  I  1 


3=1 


*',*-4-1 


=  y2A2(Adxr]  ■  ■  ■  Adx-i  Aj)v) 


3=1 


M+l  1,2 

3 


+  y2A(Adx-',,  •■■Adx-^Aj)v}'2 

3=1 


i,i+ 1  2,3 

3 


+  •  •  •  +  E  A(AdX7]  A3>)~hi  +  A+1 


3=1 


«',*'+ 1 


(35) 


Thus,  the  (i  +  l)-th  nonholonomic  constraint  can  be  expressed  as  a  linear  combination 
of  the  t^’s  and  the  shape  velocities  u1,2,  . . .  ,  u’,,+1,  for  i  =  1, . . .  ,1.  Then  (34)  follows. 
From  its  form,  and  especially  from  the  expressions  for  the  diagonal  blocks  *k,k>  we  can 
easily  see  that  A  has  always  maximal  rank  p  =  i  +  1. 


Since  A  has  always  maximal  rank  p ,  its  null  space  Af(A)  has  dimension  m  d=f  n  —  p  — 
2 P- 

Proposition  2.2.4 

Assume  that  the  velocities  v  can  be  reordered,  so  that  the  matrix  A  is  partitioned 
as  A  =  ( Ai  A2 ) ,  with  Ai  a  p  x  m  matrix  and  A2  a  locally  invertible  p  x  p  matrix. 
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Let  the  corresponding  partition  of  the  velocity  vector  be  v  =  ^  ^  ,  wi 

1/2  6  IRP.  Then,  there  exists  an  n  x  m  matrix  B  such  that: 


with  v\  G  IRm  and 


B  v\  . 


(36) 


Proof 


The  matrix  B 


(Imxm  \ 


works. 


Notice  that,  since  A  depends  only  on  the  shape,  so  does  A 2.  In  addition,  the  choice 
of  the  locally  invertible  matrix  A2  is  dictated  by  the  choice  of  the  splitting  of  v  into 
1/ 1  and  i/2 .  For  a  particular  choice,  as  the  shape  is  altered,  A2  will  become  singular  at 
certain  shapes.  The  corresponding  configurations  of  the  VGT  assembly  shall  be  referred 
to  as  nonholonomic  singularities.  It  will  be  apparent  that  these  singularities  are  not 
removable  by  merely  choosing  alternative  splittings  of  v  or  alternative  parametrizations 
of  the  configuration  space  (e.g.  how  we  assign  orderings  to  the  kinematic  chain  at  hand). 
In  these  configurations,  the  system  kinematics  together  with  the  shape  control  may  not 
provide  sufficient  information  to  determine  its  motion  and  the  dynamics  of  the  system 
may  have  to  be  considered. 

Remarks 

1)  Unlike  previous  work  on  nonholonomic  motion  planning,  in  our  case  the  V\  s  of 
equation  (36)  do  not  correspond  directly  to  the  controls  of  the  system  and,  thus,  are 
not  at  our  disposal  to  alter  at  will.  Our  real  controls  are  the  leg  velocities  &  of  the 
parallel  manipulator  modules  (see  section  2.3).  However,  as  we  will  see  in  section  2.3, 
off  the  kinematic  singularities  of  the  parallel  manipulators,  the  shape  controls  can  easily 
determine  the  corresponding  leg  velocities.  Therefore,  in  order  to  simplify  the  discussion 

of  motion  planning,  once  the  partitioning  of  the  velocity  vector  v  as  ^  ^  ^  is  done  in 

such  a  way  that  all  the  i/ffs  are  controllable  from  the  d’s,  we  will  disregard  the  particulars 
of  the  implementation  of  the  modules  and  only  consider  the  shape  controls.  Note  that 
when  l  =  1,  such  a  partitioning  of  the  velocity  vector  cannot  be  done. 
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2)  The  3£  holonomic  constraints  imposed  by  the  legs  of  the  modules  of  the  ^-module 
VGT  assembly  determine  the  shape  x  ,X  ,  •  •  • ,  X  of  the  assembly.  In  order  to  de- 

1,2  2,3 

termine  completely  its  configuration,  we  also  need  to  specify  the  position  and  orientation 
of  the  assembly  with  respect  to  the  world  coordinate  frame,  given  by  an  element  (x  in 
this  case)  of  G  =  SE(2).  Thus,  we  need  3  more  constraints.  These  come  from  the  £  +  1 
nonholonomic  constraints  provided  by  the  platform  wheels.  Consider  now  some  special 
cases:  i )  If  £  =  1,  we  have  3  holonomic  and  2  nonholonomic  constraints,  but  we  need 
to  determine  6  degrees-of-freedom,  thus  we  do  not  have  enough  kinematic  constraints 
to  determine  the  motion  of  the  assembly.  We  either  have  to  consider  its  dynamics  or 
we  need  to  impose  additional  constraints  (e.g.  unidirectional  wheel  motion),  n)  If 
£  =  2,  we  have  6  holonomic  and  3  nonholonomic  constraints  and  we  need  to  determine 
9  degrees-of-freedom,  thus  we  have  exactly  the  required  number  of  constraints.  Hi) 
If  l  >  2,  we  have  S£  holonomic  and  £  +  1  nonholonomic  constraints  and  we  need  to 
determine  3(1  -fi  1)  degrees-of-freedom,  thus  we  have  3£  +  (£  +  1)  —  3(f  +  1)  =  l  —  2 
extra  constraints  that  have  to  be  satisfied.  Therefore,  from  the  3 £  shape  velocities,  only 
3£  —  (£~2)  =  2(£  +  l)  can  be  determined  independently  and  will  be  elements  of  the  vector 
V\  in  equation  (36).  The  remaining  £-2  shape  velocities  will  be  determined  by  the  £-2 
extra  constraints,  i.e.  they  will  be  elements  of  the  vector  ,  together  with  the  velocities 
that  characterize  the  global  motion  of  the  assembly  (here  they  are  the  t^’s).  Observe 
that  if  there  exists  k  such  that  £  —  2  =  3 k,  we  can  choose  £  —  A;  of  the  £  modules  and 
alter  their  shape  at  will,  while  the  shape  of  the  remaining  k  modules  will  be  determined 
by  the  extra  constraints.  In  brief,  for  £  >  2,  the  problem  is  over-constrained. 

3)  The  2-module  VGT  is  “canonical”  in  the  following  sense:  Suppose  that  we  change 
the  ^-module  VGT  architecture  (for  £  >  2)  so  that  we  have  wheels  on  only  3  platforms 
and  castors  on  the  remaining  £  —  2  platforms.  Then  we  have  only  3  nonholonomic 
constraints  (instead  of  £  +  1).  Such  a  system  has  exactly  the  number  of  constraints 
needed  to  determine  its  motion,  which,  in  our  original  VGT  assembly  is  the  case  only  for 
£  —  2.  The  motion  planning  strategies  that  will  be  determined  for  the  2-module  VGT 
will  work  also  for  this  ^-module  assembly.  Moreover,  this  ^-module  assembly  possesses 
3^  —  6  degrees-of-freedom  more  than  the  2-module  VGT  and  those  can  be  exploited  for 
other  purposes  (e.g.  for  motion  in  a  constrained  environment,  or  for  generating  a  richer 
repertoire  of  motions  of  the  type  described  in  (Chirikjian  &  Burdick  [1991])). 
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2.3  Implementation  of  a  VGT  module  as  a  Parallel  Manipulator 

Consider  the  i-th  module  of  the  VGT  assembly,  implemented  as  a  planar  parallel 
manipulator  (Fichter  [1986]).  This  consists  of  the  i-th  and  (i  +  l)-th  platforms,  which 
are  connected  by  three  legs  of  variable  length.  One  possible  architecture  is  shown  in  fig. 
2.1. 

In  previous  sections  we  saw  that  the  shape  of  the  i-th  module  is  determined  by 
X.  .  €  SE( 2).  Let  pP'k,  for  k  =  i,i  +  1,  j  =  1,2,3  be  the  position  of  the  jf-th  joint  of 

the  fc-th  platform  with  respect  to  the  coordinate  system  of  this  platform.  Consider  the 
following  quantities,  defined  with  respect  to  the  coordinate  system  of  the  i-th  platform: 
the  position  Pj+1  of  the  (i  +  l)-th  platform,  the  vector  Sj  and  the  length  o'-  of  the 
j-th  leg  of  the  module.  Let  o'  be  the  vector  of  the  leg  lengths  of  the  i-th  module,  i.e. 
o{  d=  ( o[  o\  o'z)T. 

The  inverse  kinematic  map  E~l  :  SE( 2)  — ►  specifies  the  leg  lengths  of  the 
module  as  functions  of  its  shape  x.  .  •  We  can  easily  see  that  for  the  j-th  leg: 


Then  the  leg  lengths  of  the  module  are  given  by 

o)  =  ||Sj||  =  S),S)  >  ,  for  j  =  1, 2, 3  , 


(38) 


where  <  . ,  .  >  is  the  inner  product  in  lRn  and  j| .  ||  is  the  corresponding  norm.  Then 
the  inverse  kinematic  map  is: 


T 


-l 


" 


(39) 


Proposition  2.3.1  (Velocity  Kinematics) 

The  body  velocities  of  the  i-th  module  v‘,,+1  and  the  changes  of  length  of  its  legs  o'  a= 
(o[  b\  <T3)t  are  related  by: 


E(»V  -  . 


(40) 


where  S(a')  =  diag{o[ ,  o\  ,  and  J(x.  .  )  = 


SjTRi,i+i  pPj+1  |  S)TRiii+l 


J : 
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Proof 


From  (38)  :  (a))2  =<  5),  S’-  >  .  Differentiating  both  sides  and  defining  ft  d=  v|’,+I  and 

def  /u‘-i+1\  . 

=  =  !  J  »  We  §et: 

oft  =<  S),s )  >=<  S),Riti+1( E  +  ClpPft)  > 

=<  Rij+i r Sj,E  +  Pfft1  T ft  >=<  pP}+lRiii+1TS},il>  +  <  Riti+xJ Sj, 3  >  , 
where  Ri,i+i  was  defined  in  (22).  Then  (40)  follows. 

■ 

Configurations  where  J(x)  is  singular  are  called  kinematic  singularities.  Those  do 
not  have  anything  to  do  with  nonholonomic  singularities. 

Corollary  2.3.2 

Suppose  the  configuration  y.  .  G  SE( 2)  of  the  i-th  module  is  not  a  kinematic 
singularity  and  that  the  corresponding  leg  lengths  are  a'.  Then: 

£(<t'V  (41) 

and 

V‘)J(x.  .+l)»'''i+1  •  (42) 


Observe  that  after  we  specify  the  shape  controls  uM+1,  the  corresponding  leg  length 
changes  can  be  easily  determined  from  (42).  Therefore,  our  discussion  of  the  motion 
planning  problem  can  disregard,  without  loss  of  generality,  the  particular  implementation 
details  of  the  modules  and  consider  only  the  shape  controls. 


3  The  2-module  VGT 

In  section  3.1  we  consider  the  kinematics  of  the  2-module  VGT  (fig.  3.1)  as  a 
special  case  of  the  kinematics  of  the  ^-module  VGT.  We  show  that  the  velocity  vector 
can  be  partitioned  in  two  parts,  one  of  which  constitutes  the  independent  shape  controls 
and  the  other  being  velocities  dependent  on  the  shape  variables,  which  characterize  the 
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motion  of  the  assembly  with  respect  to  the  world  coordinate  system.  In  section  3.2  we 
examine  the  motion  planning  problem  for  the  2-module  VGT  assembly.  We  show  that 
shape  actuation  strategies,  where  one  module  keeps  its  shape  fixed  and  the  other  varies 
it  periodically,  induce  a  rotation  of  the  VGT  assembly  around  the  instantaneous  center 
of  rotation  of  the  first  module.  If  the  platforms  of  the  fixed  shape  module  are  parallel, 
the  induced  motion  is  a  translation  along  a  direction  perpendicular  to  the  platforms. 
We  allow  the  shape  of  the  second  module  to  describe  a  closed  path  in  shape  space  and 
show  that  a  net  displacement  of  the  VGT  assembly  with  respect  to  the  world  coordinate 
system  is  induced  after  each  traversal  of  the  shape  space  path. 

3.1  Kinematics  of  the  2— module  VGT 


Fig.  3.1 


In  the  assembly  of  fig.  3.1,  we  consider  a  chain  of  t  =  2  VGT  modules.  This  system 
has  n  =  9  degrees-of-freedom,  its  configuration  space  is  Q  =  G  X  S,  where  G  =  SE( 2) 
and  the  shape  space  is  S  =  SE( 2)  X  SE( 2)  and  it  is  subject  to  6  holonomic  constraints 
from  the  parallel  manipulator  legs  and  to  p  =  3  nonholonomic  constraints  from  the 
rolling-without-slipping  assumption  on  the  wheels.  From  the  system  kinematics  we 
have  (specializing  the  results  of  section  2): 

*2  —  X1X12  > 

*3  =  *2*2,3  =  *1*1, 2*2, 3  ’  (X) 

Y  =  Y  Y 
A13  A1,2A2,3 
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From  (2.25)  we  get  for  the  corresponding  velocities: 


V2  =  Adx-i  Vx  +  Vi, 2 

1,2 

V3  =  Adx- 1  V2  +  V2,3  =  Adx- 1  Adx-i  V\  +  Adx-\  Vi, 2  +  V2,3  (2) 

2,3  2,3  1,2  2,3  v  ' 

Vi  ,3  =  Adx- 1  Vi  2  +  ^2  3 
2,3 

The  nonholonomic  constraint  of  rolling-without-slipping  on  the  wheels  of  each  platform 
can  be  expressed  using  (2.32)  as: 


v\  —  =  ioi  cos  <f>{  +  VOi  sin  <f>i  =  0  ,  i  =  1,2,3  . 


(3) 


The  3  nonholonomic  constraints  can  be  put  in  the  matrix  form  of  (2.33)  : 


a(x,j,X2j)v=  0, 


(4) 


where  v  —  [  v1,2  J  .  The  matrix  A  is  a  function  of  only  the  shape  variables  Xx  2>  X2  3  °f 
the  chain  and  is  a  block  lower  triangular  matrix  of  the  form: 


^(^1,2 ’^2,3) 


*i,i  0  0 

*1,2  *2,2  0 

,  *1,3  *2,3  *3,3, 

/  0  1  0 

A2(Adx-i  Ai)  A2(Adx-i  A 2)  A2(Adx-i  Az) 

‘  1,2  1,2  1,2 

A2(Ady-l  A\)  A^fAdjf-lAz)  A2(  Ad  y-l  Az) 

\  1,3  1,3  1,3 


0  0  0  0  0 

0  1  0  0  0 

A2{Adx-i  Ai)  A2(Adx-i  A2)  A2{Adx-i  Az)  0  1 

2,3  2,3  2,3 


O' 

0 

0 


0 

V’2 

-7  ,3 
7  3 


1 


0 


1.2  •  1,2 

cos  71  sm  7j 

1.3  •  1,3 

cos  71  ’  sm  7j  ’ 


0 

0 


0 

1 


0 

0 


2,3  2,3  •  2,3  n 

-73’  cos7x’  sm71’  0 


0  0  0 
0  0  0 
1  0 


Equation  (4)  can  be  put  in  the  form  (2.36)  by  partitioning  vasi)=  1  with 


(5) 


"1  =  (v2’3)  and  V2  =  vl 


(6) 
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and  by  partitioning  A  as  (Ai  A2 )  with 


^(x2i3) 


0  0  0 

0  1  0 

tit  AA  .  A. \  /ih 


0  0  O' 
0  0  0 

«42 (Ad^-iAi)  A2(j4dx-i  ^2)  A\(Adx-i  A3)  0  10 


2,3 


2,3 


0 

0 


0 

1 


0 

0 


0  0  0 
0  0  0 


— 73’3  COS72’3  sin73,3  0  10, 


2,3 


(7) 


and 


/ 


^2(*l,2’*2,3) 


■A2(.A<ix-i  “^1)  -A2(Adx— 1  ^2)  -42(A<fx-i  A3) 


\ 


1,2 


1,2 


1,2 


A2 (Adx-i  A\ )  A2(-Adx-i  A2)  A2(Adx-i  Aj) 


1,3 


1,3 


1,3 


0 


0 


(8) 


=  I  -^3  COS7\l  Sin7l3 
-73  cos  7i ,3  sm  7i  ’3 

Then  the  velocity  of  the  2-module  VGT  assembly  with  respect  to  the  world  coordinate 
system,  as  it  is  characterized  by  v1,  can  be  expressed  as  a  function  of  only  the  shape 
variables  of  the  assembly: 


v1  =  -^1(xi  2>X2i3)^i(x2t3)  (y’,3) 


(9) 


The  nonholonomic  singularities  of  the  system  can  be  specified  by  considering  the  deter¬ 
minant  of  the  matrix  A2  : 


def(A2)  —  A\{Adx-,  Aj  )A2  (Adx-i  A3)  —  A2(Adx- 1  Ai)A2(Adx-i  A3l) 

1(3  1)2  lt2  1)3 

1,3  •  1,2  .  1,2  .  1,3 

=  -73  smii  +  73  sin  7j  . 


(10) 


Observe  that  when  sin7j’2  7^  0  and  sin7^’3  7^  0  : 


det(A2)  =  sin7j’2  sin7i’3 

=  sin 7} ’2  sin  7} ’3  [Az0a,3  -  Aaro,,2]  , 


73  3 
sin  Ji'3 


1,2 

73 

1,2 

sm  7l 


(11) 


def 

where  A  in,  .  =  —  .  3  ,  ;  ,  j  =  2,3,  is  the  distance  of  the  intersection  0 1  ,•  of  the  axis 

*•>  smij 

of  platform  1  with  the  axis  of  platform  j  from  the  point  0 1,  as  shown  in  fig.  3.2.  It  will 
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Fig.  3.2 


be  shown  in  the  next  section  that  the  point  Oij  coincides  with  the  instantaneous  axis 
of  rotation  of  the  module  composed  by  the  platforms  1  and  j. 

Then,  the  matrix  Ai  is  singular  whenever  the  points  0i,2  and  0\^  coincide  (the 
point  0i,2,3  may  be  at  infinity  as  in  fig.  3. 3. a).  Even  in  this  case  the  3  nonholonomic 
constraints  remain  independent  (c.f.  equation  (5),  where  rank(A)  =  3),  but,  since  the 
platforms  have  a  common  instantaneous  center  of  rotation,  equation  (4)  cannot  be  recast 
in  the  form  of  (9).  Therefore,  motion  with  respect  to  point  0i,2,3  cannot  be  controlled  by 
the  system  shape  variables  alone  and  the  dynamics  of  the  system  ought  to  be  considered. 
This  is  analogous  to  what  practising  engineers  refer  to  as  loss  of  control  authority. 


(a)  (b) 

Fig.  3.3 


From  (8)  : 


A-1  =  1 

2  det(A2) 


2,3  •  1,3 

sin  7j  —  sm  71 

7\2Sil1  7lY,3_  7^,3Sin  7ll’l2,2  01,3 

-73  cos  7l  +73  cos  7!  -73 


sin  7 1’2 


(12) 
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Then,  from  (9)  we  get: 


v1  = 


-1 


det(A2 ) 


sm  7i’73’ 

0 

_ .1,2  2,3 

73  73 


■  sin  ’3  +  sin  7  J  ’2  cos  7 2  ’3 
—73  3  +  73  2  cos 7x’3 


1,2  •  2,3 

sm71  sm7j 

7.3 ’2  sin  7i2’3 


0  sin  71  ’2 
0  0 


/  v1,2 
v2,3 


(13) 

Observe  that  the  partitioning  of  v  in  equation  (6)  is  the  only  one  that  assigns  to  zq 
shape  controls  which  can  be  affected  by  leg  length  changes  in  the  parallel  manipulator 
modules.  Moreover,  it  assigns  to  zq  the  velocities  that  characterize  the  global  motion  of 
the  VGT  assembly  with  respect  to  the  world  coordinate  system. 

From  x  =  x  Vi  and  the  definition  of  the  basis  {Mi}  of  G,  it  is  easy  to  see  that, 

away  from  the  nonholonomic  singularities,  controllability  is  guaranteed  for  a  generic  set 

/V-2\  . 

of  shape  controls  I  ^2,3  I  whenever  the  1st  and  3rd  rows  of  the  matrix  A2  A\  are  linearly 

independent.  However,  the  latter  always  holds  away  from  the  nonholonomic  singularities. 


3.2  Motion  Planning  for  the  2-module  VGT 

There  are  several  possible  actuation  strategies  for  the  2-module  VGT.  We  will  con¬ 
sider  a  simple  one  where  the  first  module  “steers”  the  system,  while  the  second  provides 
the  translation  mechanism  through  periodic  variations  of  its  shape  parameters. 

From  (13)  we  observe  that  the  motion  of  the  system  is  determined  completely,  at 
least  away  from  the  nonholonomic  singularities,  by  the  shape  controls  v 1,2  and  v2'3.  Here 
we  will  consider  the  special  case  of  motions  that  are  generated  by  keeping  the  shape 
of  the  first  module  fixed,  i.e.  u1,2  =  0,  and  vary  the  shape  controls  v2'3  of  the  second 
module  periodically.  Then  from  (2.7) : 


=  0  =>-7 


1,2 


=  71’2(0) 


(14) 


Also  : 


72,3  = 


7i 

J,3 

7$  3 
7I’3 


-2,3 
732  3 

-72’ 
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(15) 


Then  from  (2.8)  : 


722’3(0  =  722’3(0)  cos  ^  J  vj’3(a)d<7^ 

v  o 


t  t  t 

^ j  v\’3((r)da^  dr  +  J  vl'3 (t)  sm  j  v3’3(a)da'jdr 


5 


l  ”  V 

7^-3(i)  =  -72,3(0)  sin  ^  J  vl^i^da^j  +  73’3(0)  cos  ^  J  vl'3(cr)dcrj 

0  o 

t  t  t  t 

-  [  vl'3(r)sm(J  vl'3(a)dajdr  +  J  vl'3(r)coS\^J  v{'3(cr  )dajdr  . 

0  V  r  0  r 

(16) 


From  (2.31),  (10)  and  (14)  : 


det(A2)  =  -731,3  sin7i1,2(0)  +  73,2(°)  sin7i1,3 

=  -  [tf  -  721,2(0)sin7i2’3  +  731,2(0)cos7i2’3 


sm 


711’2(0) 


(17) 


+  73'2(0)sin(7i1,2(0)  +  7i’3) 


From  (13)  : 


v 


l 


-1 

det{A2) 


sin  7j’2(0) 
0 

73’2(0) 


:)  •“ 


det(A2) 


sm711’2(0)' 
0 

73’2(0) 


(18) 


and  from  (2.7)  : 
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Then  from  (2.8) : 


Proposition  3.2.1 

If  vi,2  =  o  and  jj’2  =  0,  the  2-module  VGT  translates  along  an  axis  perpendicular 
to  platforms  1  and  2. 

H )  if  vi,2  _  o  and  tJ’2  ^  0,  the  2-module  VGT  rotates  around  the  intersection  of 
the  axes  of  platforms  1  and  2. 

Proof 

i )  Translation  :  Let  7J’2  =  0.  From  (17)  and  (18): 


Vi  =  0  , 

v]  =  0  , 


(21) 


A/l  'flit)  =  7^(0)  , 

7]  =  0  ’  ^  t 

73  =  vl  ,  73(0  =  73(0)  +  J  vl(T)dT  ■ 


(22) 
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From  (2.16) : 


/  ioA  /  — sin7i(0)\ 

Is '9i  \  =  v: 1  (  c°s7i(°)  I  •  (23) 

Thus,  platform  1  translates  along  the  axis  that  passes  through  the  point  (x0l  ,  yQl)  and 
is  parallel  to  the  vector  (—  sin  7i(0) ,  COS7}  (0)),  i.e.  perpendicular  to  the  platform.  This 
is  a  constant  vector,  thus  the  point  0\  traces  a  straight  line.  Moreover,  since  (j)\  is 
constant,  the  whole  platform  translates  along  this  line. 

ii )  Rotation  :  Let  y}’2(t)  =  7i’2(0)  ^  0.  The  instantaneous  center  of  rotation  (ICR) 
of  the  velocity  distribution  of  equation  (18)  (Botteiha  &  Roth  [1979])  can  be  proven  to 
be  the  point  0^2,  where  the  axes  of  platform  1  and  2  intersect.  To  see  this,  assume 
that  the  ICR  has  coordinates  (ip,  y\, )  with  respect  to  the  fixed  world  coordinate  system 
and  (zp2,2/p2)  with  respect  to  the  moving  coordinate  system  of  platform  1.  Define 
xp  —  (xp  yp  1)T  and  Xp  =  (xp2  t/p2  1)T.  By  its  definition,  Xp  —  0.  Then: 

xp  =  XpXp  ^  ip  ~  X-Ap  +  X^p  -  x^iXp  .  (24) 

The  ICR  is  defined  as  the  point  where  ip  =  0.  From  this  and  (24)  we  get: 

1,2 

VxXP  =  0  =»  x1/  = - ,  y lp2  =  0  .  (25) 

sm  7i  ’ 

From  fig.  3.2,  it  is  easy  to  see  that  this  is  point  O the  intersection  of  the  axes  of 
platform  1  and  2. 

Furthermore,  it  is  possible  to  show  that  the  ICR  is  constant,  not  only  with  respect  to 
the  coordinate  system  of  platform  1,  as  is  immediately  evident  from  the  expressions  for 
(xp2,yp2)  in  (25),  but  also  with  respect  to  the  world  coordinate  system.  Therefore,  the 
motion  of  the  system,  is  indeed  a  rotation  around  this  point.  To  see  this,  consider  the 
vector  xp  as  a  function  of  time  t  and  expand  in  Taylor  series  around  a  fixed  time  instant 
to-  Then,  defining  At  =  t  -  to,  we  get: 

By  definition:  —  x^p  +  X^Xp  —  Xp  =  0.  Moreover,  from  (18)  and  (25)  : 

=  xAp  +  +  xxXp  =  XpXp  =  (XjFi  +  x^V\)Xp  =  0  . 
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Similarly,  all  the  higher  derivatives  of  xp  are  zero  under  the  given  velocity  distribution. 
Thus  the  ICR  is  a  constant  point. 


In  the  case  where  v 1,2  =  0,  consider  the  following  periodic  shape  controls  for  the 
second  module: 


2  3 

«1’  =aiu;coswt, 

v\'z  =  a2wsin  ut  COS72’3  ,  (26) 

2  3  •  ,  2  3 

v3’  =  — OqWSmwtSU)^'  • 

From  (16)  : 

7i’3(0  =  7?'3(0)  +  ai  smut  , 

722’3(t)  =  72’3(0)  cos(a!  sin  ut)  +  73’3(0)  sin(aq  sina>t)  +  a2(l  -  cos  ut)  COS72’3  ,  (27) 

732’3(0  =  ~72,3(0)  sin(aj  sinwt)  +  73’3(0)  cos(ai  sin  ut)  -  a2(l  -  cos  ut)  sin72  '3  . 


From  (2.15)  and  (27)  we  see  that  those  shape  controls  correspond  to  a  closed  elliptical 
path  in  (x2)3,  <?!>2i3)-space. 

We  attempt  to  specify  the  global  motion  of  the  VGT  assembly  induced  by  the  shape 
controls,  as  characterized  by  the  position  and  orientation  7*  of  platform  1.  We  saw  that 
instantaneously  this  motion  is  a  translation  whenever  ~/1  ’  =  0  or  a  rotation  whenever 
7*’2  0.  We  want  to  find  out  if,  after  a  period  T  =  of  the  shape  controls,  there 

is  a  net  motion  A71  d=f  7 1(T)  —  71(0)  of  the  VGT  assembly.  This  is  equivalent  to  the 
geometric  phase  idea  of  (Krishnaprasad  [1990]). 

Translation:  Let  7J’2  =  7i’2(0)  =  0. 

From  (21)  and  (22)  : 

^7i(0  =  li(t)  —  7i(0)  =  0  , 

A72W  =  72(0  -721(°)  =  0  , 

t 

=  73  W  -  73(0)  =  J  vl(r)dr 

0 


=  -a2 


t 

/ 


(28) 


u  sin  ut 


tan(a3  +  aq  sinwr) 


dr 
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Gamma*l_3  by  numerical  integration 


Carina*  1_1  by  numerical  Integration 


Fig.  3.5 


where  <23  d=  7i’3(0). 

From  (2.15)  and  (28)  we  have: 


<t>  1  =  7i(0)  , 

xo1  =  72(0)  cos7i(0)  -  73  sin  7x(°)  )  (29) 

yox  =  72(°)sin7i(0)  +  73  cos  7i(0)  . 


From  this  we  get: 


„  72 (0) _ 1 

°l  sin7i(0)  tan7j(0)  °l 


(30) 


Thus  the  locus  of  the  point  0\  is  the  straight  line  given  by  equation  (30),  which  is 
perpendicular  to  the  axis  of  platform  1.  Using  Mathematica,  we  can  integrate  (28) 
numerically  and  verify  that  after  a  period  of  the  shape  controls,  the  2-module  VGT 
assembly  has  moved  forward  by  a  distance  specified  by  A73(^y)  =  73(77)  —  73(0)  (fig. 
3.4).  If  we  trace  the  closed  shape-space  path  of  (26)  in  the  reverse  direction,  the  assembly 
will  move  backwards  by  the  same  distance. 


Rotation:  Let  7j’2  =  j}’2(0)  ^  0. 

In  Prop.  3.2.1  we  saw  that  the  instantaneous  motion  of  the  2-module  VGT  in  this 
case  is  a  rotation  around  the  point  Oi,2-  The  position  of  the  assembly  with  respect  to 
this  point  can  be  characterized  by  the  angle  7*. 
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From  (2.31)  and  (27)  : 


7J’3(i)  =  Ti1’2  +  7i’3  =  7i1,2(0)  +  7i’3(0)  +  sin  ut  , 

731,3(0  =  73  3  —  72  2  siQ7i’3  +  73 ’2  cos7i’3 

=  -72,3(0)sin(ai  sinwi)  +  73,3(0)  cos(ai  sin ut)  (31) 

—  ^72 ,2(0)  +  0:2(1  —  coso>t)j  sin  (72,3(0)  +  «i  s'mcotj 

+  73,2(0)cos  (72,3(0)  +  ai  sinwi)  . 


Then,  from  (17)  : 

det(A2(t))  =  -73,3(<)sin7l1,2(0)  +  73’2(0)sin7l1’3(f)  .  (32) 


From  (18)  : 


and  from  (20)  : 


vi(*)  =  -s5n7i'2(°) 


det(A2(t)) 


A7l1(f)  =  7i(0  ~  7i(0)  =  -sin7i1,2(°)  J 

0 


det(A2(r)) 


dr  . 


(33) 


(34) 


Using  Mathematica,  we  can  integrate  (34)  numerically  and  verify  that  for  e.g.  7l  ’  =  —  j, 
after  a  period  of  the  shape  controls,  the  2-module  VGT  assembly  rotates  clockwise 
around  the  point  Oi,2  by  an  angle  specified  by  A7J(^y)  =  71(77)  -  7i(°)  (%•  3-5).  If 
we  trace  the  closed  shape— space  path  of  (26)  in  the  reverse  direction,  the  assembly  will 
rotate  counter-clockwise  by  the  same  angle. 

The  2-module  VGT  nonholonomic  kinematics  were  simulated  on  a  Silicon  Graphics 
IRIS  4D/120  graphics  workstation.  The  primitive  straight  line  and  rotational  motions 
described  above  are  shown  in  fig.  3.6  and  3.7.  Those  primitive  motions  can  be  synthesized 
to  display  more  complex  behaviors  of  the  system,  like  obstacle  avoidance,  as  shown  in 
fig.  3.8. 
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ms# 


Fig.  3.6 


Fig.  3.7 


Fig.  3.8 


4  Conclusions 

In  this  paper  we  introduced  Variable  Geometry  Truss  assemblies  with  nonholonomic 
constraints.  We  derived  their  kinematics  and  examined  motion  planning  by  showing  how 
periodic  shape  changes  induce  global  translation  or  rotation  of  the  assembly  under  the 
influence  of  the  nonholonomic  constraints.  The  framework  discussed  here  is  an  instance 
of  a  class  of  nonholonomic  systems  that  we  refer  to  as  G-snakes.  An  outline  of  this  was 
discussed  by  one  of  us  at  a  recent  workshop  (Krishnaprasad  [1993]).  Details  appear  in  a 
forthcoming  paper. 

Further  exploration  of  motion  planning  through  alternative  shape  change  strategies 
can  be  based  on  the  above  framework.  In  (Tsakiris  &  Krishnaprasad  [1993]),  configu¬ 
ration  space  trajectories  for  parallel  manipulators  that  minimize  curvature-squared  cost 
criteria  were  shown  to  generalize  the  usual  straight  line  and  circular  arc  configuration 
space  paths.  These  can  be  used  to  create  a  richer  family  of  closed  shape-space  paths 
than  the  ones  presented  in  Section  3.2.  Moreover,  shape  changes  like  those  presented  in 
(Chirikjian  &  Burdick  [1991])  can  be  explored  for  the  ^-module  VGT  architecture  (c.f. 
Remark  3,  Section  2.2). 

Finally,  we  can  consider  integration  of  this  mechanical  system  with  various  obstacle 
avoidance  (Latombe  [1991])  and  sensory  information  mediation  schemes,  in  order  to 
explore  motion  in  a  constrained  or  dynamic  environment. 
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